/*
	This file is part of AVRCppLib.

    AVRCppLib is free software: you can redistribute it and/or modify
    it under the terms of the GNU General Public License as published by
    the Free Software Foundation, either version 3 of the License, or
    (at your option) any later version.

    AVRCppLib is distributed in the hope that it will be useful,
    but WITHOUT ANY WARRANTY; without even the implied warranty of
    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
    GNU General Public License for more details.

    You should have received a copy of the GNU General Public License
    along with AVRCppLib.  If not, see <http://www.gnu.org/licenses/>.

    Copyright (C) Maxime Lemonnier 2007-2011
 */

#include "PPMCapture.h"

PPMCapture::PPMCapture(Counter16 * counter, Capturer16 * capturer, float ticksPer_us, IOAddress icPinDDR, uint16_t icPinNumber, uint8_t numberOfChannels) :
counter(counter), capturer(capturer), ticksPer_us(ticksPer_us), numberOfChannels(numberOfChannels)
{
	clearBit(*icPinDDR, icPinNumber);
	pulseWidths = new uint16_t[numberOfChannels];
	capturer->enableNoiseCanceler();
	capturer->triggerOnFallingEdge();
	capturer->connectCallback(this);
	capturer->enableICRInterrupts();
}

PPMCapture::~PPMCapture()
{
	delete pulseWidths;
}


uint16_t PPMCapture::getPulseWidth(uint8_t channelNumber)
{
	return pulseWidths[channelNumber];
}
#include <stdio.h>
void PPMCapture::callback()
{
	uint16_t currentICR = capturer->readICR();

	uint16_t currentPulse = (currentICR - lastICRvalue) / ticksPer_us;

	lastICRvalue = currentICR;

	pulseWidths[currentChannel] = currentPulse;

	currentChannel++;

	if(currentChannel >= numberOfChannels || currentPulse > 3000)
	{
		counter->setValue(0);
		currentChannel = 0;
		lastICRvalue = 0;
	}

}
